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SUMMARY 


X' - 


This report deah-with the kinematic analysis and experimentation of a force/torque sensor whose 
design is based on the mechanism of the Stewart Platforms Besides being used for measurement of 
forces/torques, the sensor also serves as a compliant platform which provides passive compliance 
during a robotic assembly task. It consists of two platforms, the upper compliant platform (UCP) 
and the lower compliant platform (LCP), coupled together through six spring-loaded pistons whose 
length variations are measured by six linear voltage differential transformers (LVDT) mounted 
along the pistons. Solutions to the forward and inverse kinematics of the force sensor are derived. 
Based on the known spring constant and the piston length changes, forces/torques applied to the 
LCP gripper are computed using vector algebra. Results of experiments conducted to evaluate 
the sensing capability of the force sensor are reported and discussed. 

1 Introduction 

For high precision tasks where the requirements of accuracy and sturdiness outweigh these of 
large workspace and maneuverability, closed-kinematic chain (CKC) mechanisms are more often 
employed than the conventional anthropomorphic open-kinematic chain (OKC) mechanism to 
design robotic manipulators, end-effectors and devices performing the tasks [l]-[27]. This comes 
from the fact that CKC robots are generally sturdier and more precise than OKC robots because 
of the closed chain nature of their mechanisms. Having links and joints actuating in series and 
being compact, OKC robots possess long reach, large workspace and are capable of entering 
small spaces. However the cantilever-like structure causes them to have low stiffness and unde- 
sired dynamic characteristics, especially at high speed and large payload. Moreover, due to the 
nonuniform distribution of payload to actuators and serial accumulation of joint errors through- 
out the OKC mechanism, OKC robots have low strength-to-weight ratios and are not capable 
of providing high precision motion needed in robotic assembly tasks. On the other hand, CKC 
robots whose mechanism are parallel, have been considered in numerous robotic applications be- 
cause of their high structural rigidity and non-serial accumulation of joint and link errors. One 
of the first applications of CKC mechanism appeared in the design of the Stewart Platform [1] 
which was later employed by Dieudonne and his coworkers [2] to design an aircraft simulator at 
the NASA Langley Research Center. Hoffman and McKinnon [3] used a finite element program 
to simulate the motion of the Stewart Platform whose mechanism was later applied by McCal- 
lion and Truong [4] to design an automatic table. Hunt [5,7] studied the structural kinematic 
problem of in-parallel-actuated robot manipulators. Applying linear algebra elements to screw 
systems, Sugimoto and Duffy [6] developed a general method to describe the instantaneous link 
motion of a single closed-loop mechanism. In order to investigate autonomous part assembly 
in space, Premack and others [8] of NASA/Goddard Space Flight Center designed and built a 
passive compliant robot end-effector whose active compliance problem was later investigated by 
Nguyen and his coworkers [9]. The kinematic problems and practical construction of the Stew- 
art Platform were considered by Yang and Lee [10], Mohammed and Duffy [11], and Fichter 
[12]. Sugimoto [13] studied kinematics and dynamics of parallel manipulators and Lee and his 
coworkers [14] derived dynamical equations for a 3 degree-of- freedom (DOF) manipulator. Rees- 
Jones [15] applied screw theory to treat Stewart Platform-based manipulators while Sharon and 
others [17] applied the Stewart Platform mechanism to design a micromanipulator performing 
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fine motion. The Stewart Platform mechanism was also applied by Kerr [19] to manufacture a 
force/torque sensor. Other problems of Stewart Platform-based manipulators such as adaptive 
force/torque control, kinematics, dynamics and workspace computation were treated by Nguyen 
and his coworkers [20,22,23]. Closed-form solutions of forward kinematics were derived by Griffis 
and Duffy [21] and Nanua and others [24] for a class of Stewart Platforms. Nguyen and others 
[25,26] developed learning control and trajectory planning schemes for parallel manipulators and 
presented experimental results of the trajectory planning schemes in [27], 

This report deals with the kinematic analysis and experimentation of a six-degree-of-freedom 
force/torque sensor whose design is based on the mechanism of the Stewart Platform. The paper 
is organized as follows. Section 2 describes and explains the functions of the main components 
of the force/torque sensor system. Sections 3 and 4 present the solutions to inverse and forward 
kinematics of the force/torque sensor, respectively. Vector equations are developed in Section 5 
for computing forces/torques. Section 6 presents results of experiments conducted to evaluate 
the sensing capability of the force sensor. Finally the content of the paper will be reviewed and 
future research activities will be outlined in Section 7. 

2 The Force/Torque Sensor System 

Figure 1 presents the force/torque system which mainly consists of a 6 DOF force/torque sensor, 
a data acquisition system and an AT 286 personal computer. The main components and the 
functions of the force/torque sensor and the data acquisition system are described below. 

2.1 The Force/Torque Sensor 

Figure 2 shows the force sensor 1 which is composed of an upper compliant platform (UCP) and 
a lower compliant platform (LCP) coupled together through six spring-loaded pistons arranged 
in a geometry similar to the mechanism of the Stewart Platform. Universal joints are used to 
mount the pistons to the two platforms. A gripper is attached to the LCP to perform assembly 
of parts. The pistons permit strain on two opposing springs acting in each piston. They are 
compressed or extended when resistive or gravitational forces are exerted on the gripper. Thus 
the force sensor mechanism also serves as a passive compliant device which provides compliance 
to the gripper during an assembly task. TRANS-TEK DC-DC gaging linear voltage differential 
transformers (LVDT) are mounted along the pistons to measure the deflection of the springs, 
which will be used to calculate forces/torques applied to gripper. The supply voltage is provided 
by a KEPCE ATE 15-3P power supply, a very stable variable voltage power supply which is 
especially suitable for high precision measurement. 

2.2 The Data Acquisition System 

As presented in Figure 1, LVDT analog signals representing the corresponding spring deflec- 
tions are processed through a CAMAC data acquisition system which consists of an Analog- 
to-Digital Converter (ADC) board, a Display Controller board, a Dataway display board, a 
CRATE controller board, and a Personal Computer (PC) interface board, all contained in a 
CAMAC Crate. The CAMAC Crate acts as a house for up to 25 boards and several busways 

1 For simplicity, from now on, force sensor is used to denote force/torque sensor. 
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for board communication, and provides DC power to the boards. The ADC board can convert 
up to 16 analog voltages into equivalent digital values using a sample- and- hold amplifier and a 
successive-approximation converter. The LVDT signals are continuously scanned and convert- 
ed, and the results are then stored in the module’s 16-word memory. The Dataway Display 
module indicates the state of all the Dataway signal lines during a Dataway cycle. It contains 
two 24-bit registers, designated as Data and Command register whose outputs are continuously 
displayed by front-panel LEDs. The Crate Controller provides an asynchronous, parallel data 
path between a CAMAC crate and a parallel I/O port of a computer. A 50-contact, flat-ribbon 
connector is used for the reception and transmission of all necessary data and control lines 
between the Crate Controller and the interface device which are 16 bits wide. The Crate Con- 
troller is accessed by calling assembly language routines which indicate to the system the type 
of information requested. 

3 Force Sensor Inverse Kinematics 

This section presents the development of kinematic equations which can be used to convert the 
piston lengths measured by the LVDTs into the corresponding pose 2 of the LCP with respect to 
the UCP. Figure 3 shows two right-hand coordinate frames {A} and {E} assigned to the UCP 
and LCP, respectively. The Centroid A of the UCP is chosen to be the origin of Frame {A}, 
the z ,4- axis is pointing outward and the x^-axis is perpendicular to the line connecting the two 
attachment points A\ and A$. In addition, 6 a denotes the angle between A\ and A-i. The angles 
between A\ and A 3 and between A3 and A5 axe set to 120° to obtain a symmetrical distribution 
of joints on the UCP. Similarly, the Centroid E of the LCP is the origin of Frame {E}, the 
x£-axis is perpendicular to the line connecting the two attachment points E\ and Eq, and $e 
denotes the angle between E\ and £2. Also the angles between E\ and £3 and between £3 and 
£5 are set to 120° in order to symmetrically distribute the joints on the LCP. The Cartesian 
variables axe chosen to be the relative pose of Frame {E} with respect to Frame {A} where the 
position of Frame {E} is specified by the position of its origin with respect to Frame {A}. Now 
if we denote the angle between AA,- and x^ by A,-, and the angle between ££,• and xe by A,- for 


i=l,2,. . . ,6, then 

A,- = 60i° - y , for i = 1,3,5 


A i = 60 i° - 

(1) 

and 

A,- = A,_i + 0e\ A,- = A,_! + 6 a , for i = 2, 4, 6. 

(2) 

Furthermore, if Vector ^e, = (e,- x e, y e,- 2 ) r describes the position of the attachment point £,• 
with respect to Frame {E}, and Vector ^a,- = (a,-* a,-j, a,- 2 ) T the position of the attachment point 
A,- with respect to Frame {A}, then they can be written as 

£ e,= 

1 T 

te cos(A t ) te sin(Xi) 0 

( 3 ) 

and 

A a,= 

^ r J 4Cos(A t ) rAsin(Ai) 0 

( 4 ) 


for i=l,2,. . . ,6 where ta and te represent the radii of the UCP and LCP, respectively. 


2 In this report, pose implies both position and orientation. 
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Let us now consider the vector diagram for an ith piston given in Figure 4. The position of 
Frame {E} is represented by Vector A d = [x y z] T which contains the Cartesian coordinates x, y, 
z of the origin of Frame {E} with respect to Frame {A}. The length vector ^q, = (q, r qi y qi z ) T , 
expressed with respect to Frame {A} can be computed by 


where 


A qi = A x, + A ei 


A Xi = A d- 



X Q>ix 


i 

H 

C3 

1 

H 

i 


x, 1 

— 

1 

** 

1 1 
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y - aiy 

z 

— 

1 

Jtfl s? 1 


( 5 ) 

( 6 ) 

( 7 ) 

( 8 ) 
( 9 ) 


which is the representation of A e,- in Frame {A} and ^R is the Orientation Matrix representing 
the orientation of Frame {E} with respect to Frame {A}. 

Thus the length /,• of Vector ^q, can be computed from its components as 


which is a shifted vector of 'M and 


A ei = E ei 



rn 

r 12 

?13 




r U e ix + 7*12 6 , 5 , 


Ui 

= 

T 21 

r 2 2 

7*23 


e iy 

— 

5*21 e,x + r 22 eiy 

= 

Vi 


. r31 

7*32 

7*33 _ 


e iz 


_ r 31 e tX + J -32 e t 'y 


. Wi . 


l i = yjvl + Qiy + Qi 


or 


li = yj{xi + Ui) 2 + (yi + Vi) 2 + 0 ,- + Wi) 2 


We obtain from (3)-(4) 


2 I 2 , 2 2 

<4 + = r E > 

2 , 2,2 2 

a ix + a iy + a iz - r A- 


and from the properties of orientation matrix 

t _2 t — _2 i _2 


r ll + r 21 + r 31 — r 12 + r 22 + r 32 


2 _ ..2 


r 13 + r 23 + r 33 ~ 1 


( 10 ) 

( 11 ) 

( 12 ) 

( 13 ) 

(14) 


and 


r U r 12 + r 21 r 22 + ^31 r 32 = 0 

r ll r 13 + ^21 r 23 + ^31 r 33 = 0 

^ 11^13 + »’ 227’23 + ^ 32^32 = 0 . 

Using (12)-(15), Equation (10) can be rewritten as 

U 2 = x 2 + y 2 + z 2 + r 2 E + t 2 a + 2(r u e ix + ri 2 e, v )(x - a ix ) 
+2(r 21 e ix + r 22 e iy )(y - a iy ) + 2(r 31 e i:E + r 32 e iy )z 
-2(xa ix + ya iy ), 


(15) 


(16) 
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for i=l,2,. . . ,6. 

Equation (16) represents the closed-form solution to the force sensor inverse kinematics in 
the sense that piston lengths /, for i=l,2,. . . ,6 which correspond to the pose of Frame {E} with 
respect to Frame {A} can be determined using (16). 

The orientation of Frame {E} with respect to Frame {A} can be described by the orientation 
matrix ^R as shown in (9) which requires nine variables r,y for ij= 1,2,3 from which six are 
redundant because only three are needed to specify an orientation [30]. There exist several ways 
to specify an orientation by three variables, but the most widely used one is the Roll-Pitch- Yaw 
angles a, (3, and 7, which represent the orientation of Frame {E}, obtained after the following 
sequence of rotations from Frame {A}: 


1. First rotate Frame {A} about the x^-axis an angle 7 (Yaw), 

2. Then rotate the resulting frame about the y^-axis an angle (3 (Pitch), and 

3. Finally rotate the resulting frame about the z ,4 -axis an angle a (Roll). 

The orientation represented by the above Roll-Pitch- Yaw angles is given by 3 


= R RPY = 


ca c/3 ca s(3 sj - sa cj 
sa c/3 sa s(3 s~f + ca 07 
—s(3 c/3 S7 


ca s/3 07 + so sj 
sa s/3 C7 — ca s-y 
c/3 c~/ 


(17) 


4 Force Sensor Forward Kinematics 


This section deals with the conversion of the lengths l, for i=l,2,. . . ,6 measured by six LVDTs 
into the pose of Frame {E} with respect to Frame {A}. This type of conversion is the force 
sensor forward kinematics which can be formulated as to find a Cartesian position specified by x, 
y, z and an orientation specified by Roll-Pitch- Yaw angles a, f3, and 7 to satisfy Equation (16) for 
a given set of pistons lengths 1, for i=l,2,. . . ,6. In general, there exists no closed-form solution 
for the above problem since Equation (16) represents a set of 6 highly nonlinear simultaneous 
equations with 6 unknowns. Consequently iterative numerical methods must be employed to 
solve the above set of nonlinear equations. In the following we will present the implementation 
of Newton-Raphson method for solving the forward kinematic problem. 

In order to apply the Newton-Raphson method, first from (11) we define 6 scalar functions 

fi(a) = (xi + Ui) 2 + (yi + Vi) 2 + (zi + w,) 2 - U 2 = 0 (18) 

for i=l,2,. . . ,6, where the vector a is defined as 



T r i 

< T \ G*l <73 <74 <75 ( Jq 

II 


and then employ the following algorithm [29] to solve for <r: 


Algorithm 1: Force Sensor Forward Kinematics 

3 ca = cos a, and sa = sin a. 
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Step 1: Select an initial guess cr. 

Step 2: Compute the elements r,j of j|R using (17) for ij=l,2,3. 

Step 3: Compute z,-, using (7) and u,-, u,-, W{ using (9) for i=l,2,. . . ,6. 

A /. 

Step 4: Compute fi(cr) and using (18) for i, j=l,2,. .. ,6. 

Step 5: Compute B, = -/,(< r) for i=l,2,. . . ,6. If J2j = i I Bj l< t°V (tolerance), stop and adopt 
or as the solution. 

Step 6: Solve A ij 6a j = B{ for 6a j fori j= 1,2,. . . ,6 using LU decomposition. If ^ a j < 

tola (tolerance), stop and adopt a as the solution. 

Step 7: Select <r new = a + 6a and repeat Steps 1-7. 

5 Computation of Forces/Torques 

In this section, we will derive mathematical expressions which utilize the spring deflections 
measured by the LVDTs to compute the forces applied to the gripper. The forces will be 
computed with respect to Frame {A} of the UCP. When external forces are applied to the 
gripper, the gripper will deflect. An equilibrium is achieved when the forces created in the 6 
pistons and its corresponding torques balance out the external force and torques, respectively 
[28]. In general, an external force applied to the gripper creates forces in the pistons and no 
torque about the gripper position G. An external torque which results from a pair of forces equal 
in magnitude, opposite in direction, and on parallel lines of action will create piston forces that 
cancel out each other and the resultant torque of all the torques created by the piston forces is 
equal to the external torque. 

We proceed to consider the vector diagram in Figure 4 which represents the LCP relative to 
the UCP after a set of external forces and torques are applied to a point G on the gripper. The 
current piston lengths, li <new for i=l,2,. . . ,6 can be computed by 

U,new = U,old "f" A/j (20) 

where U i0 ld for i=l,2,...,6 axe the piston lengths before the external forces and torques are 
applied and A/, for i=l,2,. . . ,6 axe the changes in piston lengths, measured and provided by the 
LVDTs. A force vector is expressed as the product of its magnitude and the unit vector of the 
position vector along which the force is acting [28]. The position vector ^q, along which the 
force acts on the piston is computed by 

= A d- A &i + E ei ( 21 ) 

where and which represent the current position and orientation of Frame {E} with 
respect to Frame (A), respectively, are computed by applying Algorithm 1 on U, n ew Thus the 
force acting on the ith piston is obtained by 

F. = K, Ah AjL (22) 
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where Ki denotes the equivalent spring constant of the two springs acting in the piston and 
A q.7l A q«l denotes the unit vector of the position vector along which F, acts and | A q,| denotes 
the magnitude of the position vector. Furthermore, the extension, or compression, of the springs 
A/,- is positive when F, is tensile and negative when F,- is compressive. In other words, the force 
which the springs of the ith piston applies on the gripper is equal to -F,. 

Thus when the gripper location G is in equilibrium, the force applied to the gripper is equal 
to the resultant force of the piston forces, namely 

(23) 

,=x i=i I *1*1 

As discussed above, from the fact that the torque about G caused by the external force applied 
at G is equal to zero, the external torque, M about G is equal to the resultant torque about G 
caused by the piston forces when the gripper is in equilibrium. Thus 

6 6 A a 

M = £ ^h, x F, = £ A h i x Ki Ah ^ (24) 

i=i i=i I ‘1*1 

where 

A hi = A d- A ^ + A R E gi , (25) 

and x denotes the vector product. 

6 Experimental Verification 

In this section, experiments are performed to evaluate the sensing capability of the force sensor. 
In the following two experiments, the data of the piston lengths provided by the LVDTs are 
acquired on-line via the data acquisition system and stored on the hard disk of the personal 
computer. After each experiment, computation of forces and torques are carried out off-line 
using a program written in C language, which implements the force sensor inverse and forward 
kinematics and the force computations. Then MATLAB is used to graphically display the 
obtained results. 

Experiment 1: Measurement of Pure Torques 

The first experiment is designed to test the force sensor capability of measuring pure torques. 
First the force sensor as shown in Figure 2 is calibrated to compensate any gravitational forces 
caused by the masses of the gripper assembly and the stepper motor driving the gripper mech- 
anism. This is done by setting the LVDT signals all to zero when the force sensor mechanism is 
in a symmetrical and unloaded pose by ensuring that the lengths /,• for i=l,2,...,6 as expressed in 
Equation (10) are exactly equal to each other. Weights can be externally added to the gripper 
mechanism to achieve the symmetrical and unloaded pose. In addition, before the experiment, 
the force sensor is calibrated by applying some known vertical force to the gripper using a force 
gauge and setting and scaling the LVDT signals accordingly. 

In order to apply a positive (negative) torque to the gripper, we rotate the gripper about 
an axis zq which emanates from G and is parallel to z e, as shown in Figure 4 an angle of 2 
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degrees (-2 degrees) while keeping the force sensor UCP at a fixed pose. Since only torque is 
applied to the gripper, it is expected that only torque and no force is sensed by the force sensor. 
Indeed, according to the experimental results, the forces acquired in the directions of x^-axis, 
y^-axis, and z^-axis are very negligible, which may be created by imperfect calibration of the 
LVDTs. Figure 5 presents the time history of the force signals. As expected, the torques about 
G assumes a value of 2.303 lb-in and -2.1919 lb-in when the gripper is rotated an angle of 2 
degrees and -2 degrees, respectively. 

Experiment 2: Force Measurement During Connector Mating 

In the second experiment, we use the force sensor to monitor the forces applied to the gripper 
during the mating and demating of a space-rated connector, Series 882, manufactured by G & 
H Technology, Inc. 

The UCP of the force sensor is mounted to the payload platform of a Stewart Platform- 
based robot manipulator [27] whose linear actuators axe driven by stepper motors. The gripper 
motion during the connector mating/demating is created by properly controlling the motion of 
the stepper motors. The forces applied along the x^-axis, y^-axis and z^-axis are reported 
in Figures 6, 7, and 8, respectively. The mating and demating are performed in two different 
stages. In the first stage, the connector is mated and demated under a perfect alignment between 
the connector plug and the connector receptacle and in the second stage under a misalignment 
produced by rotating the connector plug about the z^-axis an angle of -2 degrees. The force 
applied in the z^-axis is the largest as compared to those applied in the x^-axis and y^-axis 
since the gripper motion during the mating and demating is mostly vertical. As shown in Figure 
8, the forces exerted along the z^-axis during the demating in both stages are of almost the 
same value of about 26.23 lb. Figure 8 also shows that the maximum forces required for the 
mating are 28.024 lb and 39.84 lb during the first and second stage, respectively and the force 
is relatively disturbed during the second stage because of the misalignment. Figure 6 and 7 
show that the forces applied along x^-axis and y ^4- axis do not exceed 2 lbs because the mating 
and demating are performed vertically as mentioned above. The mating and demating of the 
same connector is then repeated under various misalignments. Figure 9 plots the maximum 
and average mating forces versus the misalignment degrees. As expected, the mating forces are 
positively proportional to the misalignment degrees as shown in the figure. 

7 Conclusion 

In this report, we have presented the development of the inverse and forward kinematics of a 6 
DOF Stewart Platform-based force sensor which is mainly composed of two platforms coupled 
together by 6 spring-loaded pistons. The force sensor mechanism is also used as a passive 
compliance device which provides compliance during part assembly tasks. The forces and torques 
applied to a gripper mounted to the lower compliant platform of the force sensor were computed 
using the force sensor inverse and forward kinematic equations, the equivalent spring constants 
and the piston length variations measured by LVDTs mounted along the pistons. Experiments 
conducted to evaluate the sensing capability of the force sensor showed that it is capable of 
measuring torque applied to the gripper and of monitoring transient forces applied during the 
mating and demating of a space-rated connector. The force sensor kinematic equations have 
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been optimized and are currently fast enough for real-time force computation. We will shortly 
report results of experiments such as mating/demating connectors and replacement of orbital 
replaceable units, which are performed under force feedback. 
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Figure 1: The force/torque sensor system 



Figure 2: The Stewart Platform-based force/torque sensor 
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Figure 3: Frame assignment for the force/torque sensor 
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Figure 4: Vector diagram of the ith piston 
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Figure 5: Torque about the Zq axis 
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Figure 6: Force about the axis 



Figure 7: Force along the axis 
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Figure 8: Force along the axis 
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Figure 9: Mating forces versus misalignment degrees 
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